float64 q_filt  #User filtered joint angles
float64 qd_filt #User filtered joint velocities
float64 f_filt  #User filtered joint torques
float64 ferr_filt  #User filtered joint torque errors
float64 qerr_int #The current value of the integrated error
